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ABSTRACT 

In  the  present  paper ,  a  nonlinear  dynamic  model  representing  scrub  nurse  robotic  manipulator  was  developed.  The 
mathematical  model  considers  the  different  motions  of  robot  arms.  The  Scrub  Nurse  Robotic  manipulator  (SNR) 
consists  of  two  links,  end  grabber,  moving  base  connected  to  stationary  base,  four  revolute  joints,  speech  recognition 
and  image  processing  systems.  The  model  considers  the  simultaneous  rotational  motions  oflinks  and  joints.  The  correct 
distribution  of  links ’  masses  helped  in  decreasing  joinCs  motors ’  torque.  Robot  links’  movements  controlled  by  Arduino 
control  system  and  the  links’  angles  values  verified  through  using  fuzzy  logic  control  system. 

KEYWORDS:  Robotic  Scrub  Nurse  Manipulator,  Mathematical  Model,  Torque,  Links  Angle,  Arduino  &  Fuzzy  System 


TRANS 

STELLAR 

•  Journal  Publications  •  Research  Consultancy 


Receiyed:  Oct  22,  2019;  Accepted:  Nov  12,  2019;  Published:  Mar  20,  2020;  Paper  Id.:  IJMPERDAPR202067 

INTRODU  CTION 

Robotics  is  a  new  field  of  technological  advancement  that  addresses  the  connection  of  perception  to  motion  and 
wherever  this  connection  is  intelligent,  artificial  intelligence  plays  a  key  role  in  robotics,  Francis  P.  et  al.,  2006. 

The  robotic  nurse  can  build  complete  picture  about  how,  why,  and  when  robotic  system  was  used.  It  helps 
human  scrub  nurses  during  surgical  operations.  It  also  solves  problems  of  human  nurse  with  in  a  faster  and  accurate 
manner. 


With  the  usage  of  scrub  nurses  robotic,  the  problems  like  accuracy,  speed  and  quality  in  dealing  with 
surgical  equipment’s  and  instruments  had  solved,  Nayeemuddin  M.  et  al.,  2013. 

The  Fanuc  FR  Mate  200iB  model  of  scrub  nurse  robot  was  modified  electrically  by  adding  new  connector 
devoted  to  electromagnetic  gripper  control,  C.  Perez-Vidal  et  al.,  2012. 

Quirubot  nurse  model  robot  equipped  with  speech  recognition  module  recognizes  requested  surgical 
instruments,  the  surgical  equipment’s  and  elements  located  on  storage  tray.  Today,  the  scrub  nurse  robot  can  pick 
or  placed  the  required  element  from  or  on  the  tray  respectively  depending  on  computer  vision  and  pattern 
recognition. 

The  robotic  nurse  acquires  and  maintains  current  knowledge  on  best-practice  nursing  rules  for  robotic 
surgery  by  understanding  the  operation  and  helps  improving  the  overall  flow.  Management  of  the  unanticipated 
circumstances  for  caring  patient’s  can  be  done  easily  using  robotic  nurse  with  safety  and  high  quality,  Ali  A. 


www.tjyrc.ors 


SCOPUS  Indexed  Journal 


editor@tjprc.  org 


Original  Article 


680 


Maha  M.  A.  Lashin  &  Ghada  Naif  Alnemer 


Raheem  et  al.,  2017. 

Robotic  scrub  nurse  plays  very  important  role  in  operating  room.  In  this  study,  speech  and  gesture  modalities 
system  was  implemented  after  testing.  Also,  the  average  instrument  acquisition  times  was  tested  and  compared,  Mithun  G. 
Jacob  et  al.,  2012.  The  multimodal  system  responded  faster  than  the  unimodal  systems. 

Pushkal  B.  et  al.,  2018  studied  a  kinematic  and  dynamic  modeling  for  two  links  planar  robot  manipulator.  These 
types  of  planer  robot  were  taken  as  an  example  like  robotic  nurse  system  with  two  degree  of  freedom.  The  mathematical 
formulation  for  calculating  position,  speed  and  acceleration  of  the  robot  gripper  was  derived.  Also,  the  position,  speed  and 
acceleration  of  the  links  related  to  frame  base  were  determined  through  Denavit-Hartenberg  parameters  (convention  and 
homogeneous  matrices)  kinematics  and  dynamics  formulas.  All  these  equations  and  calculations  were  done  by 
implementing  the  MALAB  software  to  design  a  code  for  developing,  simulating  results,  and  stating  analysis  plotting. 

Arduino  is  open-source  microcontroller  development  board  (Mithun  G.  Jacob  et  al.,  2013,  Wachs  et  al.,  2011, 
Joelle  P.  et  al.,  2003)  which  contains  programmable  circuit  board  and  includes  software.  It  reads  and  control  sensors, 
motors,  lights  and  several  measuring  applications. 

Artificial  intelligence,  especially  fuzzy  logic  control  system  is  the  easier  model  that  is  essential  for  the 
development  of  human  to  predict,  verify  and  optimize  the  solution  of  problems.  Mark  J.  Wierman,  2010.  Fuzzy  system 
rules  base  control  system  in  this  process  controls  the  inputs  to  obtain  the  required  outputs  with  ease  and  accuracy.  There  is 
an  analogous  form  of  in  mathematics,  where  a  complicated  problem  was  solved  in  the  complete  plant. 

Fuzzy  logic  control  is  used  to  replace  an  expert  human  operator  depending  on  fuzzy  rule-based  control  system, 
Sherif  K.  Hussein  et  al.,  2014.  They  used  analogous  form  of  in  mathematics  for  solving  the  problem  in  plant.  Using  fuzzy 
logic  control  system  ensures  excellent  study  and  guarantees  the  operation  of  interconnected  power  system. 

Implementation  of  fuzzy  logicis  is  easy  in  its  usage  as  it  does  not  need  derivative  knowledge  or  complex 
mathematical  equations,  Zafer  B.  et  al.,  2010  By  using  fuzzy  logic  control  system  parallel  to  traditional  control  techniques, 
it  improves  robustness  and  efficiency  of  the  nurse  robot  system,  Kshetrimayum  L.  et  al.,  2014. 

Alexander  C.  et  al.,  2018,  used  fuzzy  logic  control  system  for  controlling  the  movements  of  robot  arms  and  joints. 
The  membership  functions  applied  to  see  the  actual  effect  on  the  robotic  arms.  Color-clustering  technique  was  used  for 
improving  machine  vision  system  to  discriminate  between  colors  without  confusion. 

In  the  present  work,  a  review  of  two  degree  of  freedom  robot  is  discussed  in  section  1.  Then,  a  scrub  nurse  robot 
was  designed  and  implemented  with  an  Arduino-based  control  system  as  explained  in  section  2.  Section  3  include  the 
mathematical  model  that  was  created  for  this  robot  to  calculate  the  torque  required  for  moving  the  robot  links  and  joints 
and  the  equations  of  motion.  Optimization  of  links  angles  related  to  links  dimension  was  done  using  fuzzy  logic  system  in 
section  4.  The  Arduino  control  system  and  fuzzy  logic  control  system  results  are  discussed  in  section  5. 

EXPERIMENTAL  WORK 

SNR  (Scrub  Nurse  Robot)  as  shown  in  figure  1  is  used  for  performing  the  function  of  the  human  nurse  with  more  accuracy 
and  precision.  As  shown  in  figure  2,  the  robot  work  begins  when  the  surgeon  requests  a  specific  surgical  instrument. 
Through  speech  recognition  system,  the  surgeon  passes  order  to  the  robot,  and  then  arms  started  to  move  against  order  of 
Arduino  control  system.  The  scrub  nurse  robot  uses  a  webcam  to  determine  the  tool  image.  The  image  processing  for 
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template  matching  is  done  through  image  processing  code.  The  final  stage  of  the  process  is  the  picking  of  instrument  from 
tray  by  gripper  and  passing  on  it  to  surgeon. 


Link  4 


Gripper 


Link  2  (Moying  Base) 


Link  B 


Link  1  (Stationary  Base) 
Figure  1:  Scrub  Nurse  Robot. 


Figure  2:  SNR  Process  Sequences. 


Scrub  nurse  robot  contains  three  arms,  four  joints,  stationary  base  and  gripper.  Image  acquisition  device  (webcam) 
and  voice  detection  system  (speech  recognition)  for  SNR  runs  through  shields  of  Arduino.  The  movement  of  scrub  nurse 
robot  arm  is  controlled  by  Arduino  Mega  microcontroller  board.  A  C++  software  code  for  the  Arduino  control  system  had 
created  for  controlling  the  SNR  components  movements. 

EQUATIONS  OF  MOTION 

SNR  was  built  with  three  links  jointed  with  three  revolute  pairs  as  shown  in  figure  3.  Scrub  nurse  robot  motion  considered 

as^/  >  i  ~  1,2, 3, 4, 5,  ^  ^rst  t^ree  angies  for  robot  arms  movement  and  the  last  two  for  moving  gabber  angles.  Lagrangian 
approach  is  used  for  robot  arms  dynamic  equations.  Kinetic  and  potential  energy  of  robot  arms  are  obtained  from  the 
following  equations 


aO 

Figure  3:  Coordinates  of  Robot. 
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The  robot  links  dimensions,  joints  rotating  angles  and  motors  torque  specifications  are  explained  in  Table  1. 


Table  1:  Parameters  of  the  Scrub  Nurse  Robot 


Parameter 

Link  0 

(Stationary  Base) 

Link  1 

(Moving  Base) 

Link  2 

Link  3 

Gripper 

Mass  (m)  kg 

1.5 

2.00 

2.00 

1.50 

0.25 

Length  (L)  m 

0.15 

0.15 

0.50 

0.35 

0.13 

Link  angle 

0° 

270° 

150° 

135° 

75° 

Motor  Torque  (T)  N.m 

0  N.m 

2.5  N.m 

2.5  N.m 

2.5  N.m 

2.5  N.m 

The  robot  arms  have  uniform  cross  sections  and  mass  per  unit  length,  length  of  each  element  I  denoted  by 

( &  ’  and a*  )  respectively.  The  equations  of  motion  for  the  scrub  nurse  robot  arms  are  related  to  Lagrangian  dynamics 
approach  obtained  from 


d 

~dt 


dKE 


d KE  d PE 

-+—=n 


dq  J  dq  dq 


(i) 


Where; 

i=  1,2,3,4,5 


Zi  ,  is  torque  applied  at  joint  i. 
KE  -KE\  +KE2  +  KE3  +  KE/\. 


PE  =PE\  +PE2  +PE 3  +PE/\ 


(3) 

(4) 


1 


-P2gafs2  +P3g[a3a2s2  +  \a'13P23^ 


+  MGg(a2s2+a3s23)+MGgl(l-C4C5) 


(5) 


Equations  of  motion  associated  with  generalized  coordinates 


=IZ-,  5, 


obtained  as  follows 


5  5 

X'4!'  4+  X  C1  ij  (6i  ’  ej  )0i  ej  =  rl 


1=1  i  J  =1,2 


5  5 

4  +  ^  ^2 ij  » Oj  A  Oj  +E>22  -  ^2 

i=l  L7=f2 


5  5 

Ta3/  4'  +  ^3 ij  fj  A  Oj  +T>33  =  T3 

i  =1  i  ,j  =1,2 


(6) 


(7) 


(8) 
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5  5 

i  +  ^  ^4 ij  (®i  +'  )4  4/  +JJ44 =0 

i= 1  i,j= 1,2 

5  5 

y^-  4 +  y  ^5ij  (4  ^  4/  )4  4/ +  ^55 = 0 

i  =1  i  ,j  =1,2 


•^l +  ~zPlaf>c\  +  1 + 


An  = 


MG 


|  i  2(c23s4s5)2  + ;  2(*23*4*5)2 
[+(«2C2  +«3^23-  )MC5>2 


a12  =^21  =mG 


(023*455)02*3 

l+/(*23*4*5)(fl2c3+a3). 


(9) 


(10) 


(11) 


(12) 


A3-A1- MGlan  (s23s4s5 ) 


a14  =  Mq  | _/  2{-s22f4s5)(s2y4c5  “c23*4)  I 
J  [- 1 (c4*5)(o2c2  +C(3C23  _(*4c5)  J 

Ai5=Mg|^2(c23*4*5)2+/2(*23*4*5)2  1 

[-/ (*4c5)(a2c2 +03023  - /*4C5)J 


a22 


1  3  . 

~P2a2  +422 

+Mg  |(«2*3)2  +  («2C3  +«3)2} 


A23  =A32=J23+MGa3(a2c3+a3) 


a24  =  MG 


«2*3/  (C23C4C5  +*23*4) 
,-/(«2c3  +«3)(*23C4C5  “c23*4). 


a25  =mG 


-a2*3/(c23*4*5) 

+/  (&2c3  +«3)(*s  23^4^5) 


a33 


J33+MGa 


2 

3 


A34  =  A43  =-MGa3/ (*23C4C5  _c23*4) 

a35  = +53  =MGa3/ 1*23*4*5) 


(13) 

(14) 

(15) 


(16) 

(17) 

(18) 

(19) 

(20) 
(21) 
(22) 


www.tjyrc.ors 


SCOPUS  Indexed  Journal 


editor@tjprc.  org 


684 


Maha  M.  A.  Lashin  &  Ghada  Naif  Alnemer 


a44 


MGl2 


2 

(C23C4C5  +'s23‘y4) 

2 

+(s 23C4C5  ~c23s4> 


+  (C4^5)2 


M5=MGl 2 


-(C23V4V5)(C23C'4C5  +523^4) 
+('V23V4V5)(-V23C4C5  -^23*4) 


+(^4c5)(c4'v5) 


a55=mG1‘ 


(c2y4s5)2  +  (^s^s)2  +  (m^s)2 


D  11=0 

1  2  (  1  T  \ 

°22  =~P2lal  C2*P5S |  a5P2P2 +^3P23  I  S (^2  -^23) 

d33  =  P38  ^a23s23  j  +MG««3C23 
O44  =  MGgl  54c5 
d55  =MG8l  ^4*5 

FUZZY  LOGIC  WITH  LINKS  ANGLES 


(23) 

(24) 

(25) 


(26) 

(27) 

(28) 
(29) 


Fuzzy  logic  controller  as  shown  in  figure  4,  built  from  fuzzifier  block,  converts  real-world  crisp  values  to  fuzzy  sets 
through  membership  functions  (three  membership  functions  of  the  links  and  gripper  dimensions.  Inference  engine  to 
interprets  the  input  fuzzy  set  based  on  fuzzy  rules  to  decide  the  output  fuzzy  sets  (if  then  rules  for  inputs  and  outputs 
conditions).  Defuzzifier  block  converts  fuzzy  output  into  real-world  crisp  values  (output  decisions  of  the  fuzzy  logic 
control  system),  S.  Sarkar  et  al.,  2009.  The  fuzzy  logic  control  system  dictates  the  amount  and  direction  (angles)  of  links 
movements  by  controlling  the  links  servo  motors  torques. 


Figure  4:  Fuzzy  Logic  System  Structure. 


Figures5,  6  shows  the  fuzzy  logic  system  controlling  the  robot  arms  movement.  The  fuzzy  logic  system  has  five 
inputs  (dimensions  of  links  and  servomotors  torque)  and  four  outputs  (angles  of  links  movements).  Three  membership 
functions  with  three  levels  (low,  medium  and  high)  used  for  fuzzification  inputs  and  defuzzification  outputs. 
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Motof-Taque  AngMrp 


(a)  (b) 

Figure  6:  Gauss  Membership  Function  for  Inputs  (a)  and  Outputs  (b). 


If-than  rule  is  implemented  for  optimizing  the  yalues  of  outputs,  as  shown  in  figure  7,  according  to  changes  in 


links  dimension. 


Link2  0  322  Link3  =  0.: 

235  Gripper  =  0.101  Motor-Torque  = 

1.06 

Angle-Linkl  =178 

Angle-Link2  =  100 

Angle  Link3  -  98  5 

Angle-Gripper  =  48.5 
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Figure  7:  Optimaize  the  Output  for  Inputs. 


The  maximum  em  yalues  of  links  angles  related  to  change  in  input  linkes  dimenstions  is  given  in  Table  2. 
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Table  2:  Yalues  of  Maximum  and  Minumem  of  Inputs-Outputs  Yalues 


Dimenstions 

(■) 

Iuputs 

OutPuts 

Motor 

Torque 

Linkl 

Link2 

Link3 

Gripper 

Augle 

Linkl 

Angle 

Link2 

Angle 

Link3 

Augle 

Gripper 

Maiimum 

Values 

2,10 

N.ffl 

0,12 

0,41 

0,26 

0,12 

no1 

95,6" 

95° 

47.3° 

Mnuinum 

Yalues 

0,71 

N,tn 

0,04 

0,1 

0,04 

0,012 

150« 

851 

87° 

41.5° 

CONCLUSIONS 

In  the  present  work,  a  scrub  nurse  robot  with  two  basies,  two  links,  gripper  (end  effector)  and  three  jointes  are  studied.  A 
mathematical  model  for  three  degree  of  freedom  robot  was  designed.  The  Lagrangian  equation  depending  on  Lagrangian 
dynamics  approach  was  applied  on  equations  of  motion  for  the  arms  of  robot  to  calculate  angles  for  each  link  and 
determine  the  torque  required  for  each  joint.  Arduino  Mega  microcontroller  board  with  C++  software  code  was  used  to 
control  the  SNR  components  movements.  To  determine  the  maximum  and  minimum  values  of  arm  links,  gripper  angles 
dimensions,  a  fuzzy  logic  control  system  was  designed  with  five  inputs  ( length  of  two  links  and  servomotors  torque  value 
for  each  joint)  and  four  outputs  (angles  of  each  link  movement)  for  predicting  speed  and  position  of  robot  arms  related  to 
angles  of  joints  and  torque’s  of  motors. 
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